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ABSTRACT 

The  control  of  a robotic  arm  has  been  a challenge  since  earlier  days  of  robots.  The  kinematics  problem  is  defined 
as  the  transformation  from  the  Cartesian  space  to  the  joint  space  and  vice  versa.  This  paper  aims  to  model  the  forward  and 
inverse  kinematics  of  a 5 DOF  Robotic  Arm  for  simple  pick  and  place  application.  A general  D-H  representation  of 
forward  and  inverse  matrix  is  obtained.  An  analytical  solution  for  the  forward  and  inverse  kinematics  of  5 DOF  robotic 
arm  presented,  to  analyze  the  movement  of  arm  from  one  point  in  space  to  another  point.  The  5 DOF  robotic  arm  is  a 
vertical  articulated  robot,  with  five  re  volute  joints.  It  is  a dependable  and  safe  robotic  system  designed  for  educational 
purpose.  This  versatile  system  allows  students  to  gain  theoretical  and  practical  experience  in  robotics,  automation  and 
control  systems. 
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INTRODUCTION 

The  mathematical  modeling  of  robot  kinematics  is  motivated  by  the  complexity  of  robotic  systems,  which  possess 
highly  nonlinear  characteristics.  Inverse  kinematics  modeling  has  been  one  of  the  main  problems  in  robotics  research. 
The  most  popular  method  for  controlling  robotic  arms  is  still  based  on  look-up  tables  that  are  usually  designed  in  a manual 
manner  [1-4]. 

The  kinematics  solution  of  any  robot  manipulator  consists  of  two  sub  problems  forward  and  inverse  kinematics. 
Forward  kinematics  will  determine  where  the  robot’s  manipulator  hand  will  be  if  all  joints  are  known  whereas  inverse 
kinematics  will  calculate  what  each  joint  variable  must  be  if  the  desired  position  and  orientation  of  end-effector  is 
determined.  Hence  Forward  kinematics  is  defined  as  transformation  from  joint  space  to  Cartesian  space  whereas  Inverse 
kinematics  is  defined  as  transformation  from  Cartesian  space  to  joint  space.  General  methods  do  exist  for  solving  forward 
kinematics  [5-8].  The  objective  in  this  paper  is  to  present  an  analytical  solution  for  the  forward  and  inverse  kinematics  of  5 
DOF  robotic  arm,  to  analyze  the  movement  of  arm  from  one  point  in  space  to  another  point. 

KINEMATIC  MODEL  OF  5 DOF  ROBOTIC  ARM 

For  the  research  work,  5 DOF  Robotic  Arm  was  selected.  It  is  a vertical  articulated  robot,  with  five  revolute 
joints.  It  has  a stationary  base,  shoulder,  elbow,  tool  pitch  and  tool  roll.  This  simple  block  diagram  indicates  the 
relationship  between  direct  and  inverse  kinematics  problem  as  shown  in  Figure  la.  Figure  lb  indicates  robot  arm  links. 
The  coordinate  frame  assignment  is  shown  in  Figure  2. 
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Figure  1(a):  Forward  and  Inverse  Kinematics  Model;  (b)  Robot  ARM  Links 


Figure  2:  Coordinate  Frame  Assignment 

FORWARD  AND  INVERSE  KINEMATIC  ANALYSIS  OF  5 DOF  ROBOTIC  ARM 

Forward  Kinematic  Analysis 

In  this  study,  the  standard  Denavit-Hartenberg  (DH)  [9]  convention  and  methodology  are  used  to  derive  its 
kinematics.  Denavit-Hartenberg  algorithm  helps  to  find  the  position  and  orientation  of  end-effector  with  respect  to  base. 
Totally  20  Parameters  are  involved  in  5-  DOF  robotic  arm  design  as  shown  in  Tablet. 


Table  1:  D-H  Parameter  for  5 DOF  Robotic  ARM 


Joint  i 

Type 

aj(deg) 

ai  (mm) 

di  (mm) 

0i  (deg) 

1 

Base 

0 

0 

86 

0i 

2 

Shoulder 

90 

0 

0 

02 

3 

Elbow 

0 

96 

0 

03 

4 

Wrist 

0 

96 

0 

04 

5 

Gripper 

90 

0 

59.5 

05 

Based  on  the  DH  convention,  the  transformation  matrix  from  joint  i to  joint  i+1  is  given  by: 


~C6i 

-SOiCai 

SOiSai 

aiCOi 

ulTi  = 

SOi 

COiCai 

-COiSai 

aiSQi 

0 

Sai 

Cai 

di 

0 

0 

0 

1 

where,  S0i=sin  0i,  C0i  =cos  0i,  Sai=sin  ai,  Cai=cos  ai,  Sijk=sin(0i+  0j+  0k),  Cijk=sin(0i+  0j+  0k) 
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Impact  Factor  (JCC):  1.5422 


Index  Copernicus  Value  (ICV):  3.0 
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where  Te  is  end-effector  transformation  matrix. 
°T5  = Te 
Where, 


(3) 


(4) 


(5) 


(6) 


(7) 


(8) 

(9) 


nx  = ci2*c345;  ny  = Si2*c345;  nz  = s345; 

Ox  S^2?  Dy  “0^2?  Dz  0, 

ax  = Ci2*s345;  ay  = Si2*s345;  az  = -c345; 

Px  = S12*d5  + c12*a4*c34  + c12*a3*c3 
Py  = -Ci2*d5  + s12*a4*c34  + s12*a3*c3 
pz=a4*s34  + a3*s3  + d1  ^ 

INVERSE  KINEMATIC  ANALYSIS 


(10) 


Now  solving  °T5  = Te  by  equating  individual  terms  of  both  matrices,  we  get  the  inverse  solution.  The  following 
equations  will  be  used  to  obtain  the  solution  for  the  inverse  kinematics  problem  [4,  10]. 

Te  = %*  !T2*  2T3*  3T4*  4T5  = °T5  (11) 

Xi  = C0^)-1  Te  = !T2*  2T3*  3T4*  4T5  = lT5  (12) 


X1  = 
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[c^iix+s^ny,  Ci*ox+S!*oy,  Ci*ax+Si*ay,  Ci*px+S!*py] 

[-s1*nx+c1*ny,  -s1*ox+c1*oy,  -s1*ax+c1*ay,  -s1*px+c1*py] 

[nz,  oz,  az,  pz  ] 

[di*nz,  di*oz,  di*az,  l+di*pz] 

‘Ts  = 

[c2*c345,  s2,  c2*s345,  s2*d5+c2*a4*c34+c2*a3*c3  ] 

[s2*c345,  -c 2,  S2*s345,  -c2*d5+s2*a4*c34+s2*a3*c3] 

[s345  , 0,  -c345,  a4*S34+a3*s3  ] 

[0,  0,  0,  1 ] 

From  Equation  (13),  we  do  not  get  any  “0”  values. 

Equation  (12),  will  further  be  multiplied  by  (2T3)_1  *(3T4)_1  *(4T5)-1,  to  get 

X2  = Te*(°T1)"1*  (2T3)_1  *(3T4)_1  *(4T5)_1  = °T1 

From  the  element  (1,  3)  of  the  Equation  (14),  we  get, 

c345*c2*ax+c345*s2*ay+s345*az  = 0; 

0345  = tan'1  { (-az)/(c2*ax+s2*ay) } 

From  the  element  (2,  4)  of  the  Equation  (14),  we  get, 
s2*px-c2*py  = 0; 

02  = tan'Vpy/px) 

01  = 012  - 02 

Equation  (11),  will  further  be  multiplied  by  (1T2)"1,  to  get 
X3  = (“TO'1  ^('Tz)'1*  Te  = 2T3*  3T4*  4T5  = 2T5 
X3  = 

[c12*nx+si2*ny,  c12*ox+Si2*oy,  c12*ax+s12*ay,  c12*px+s12*py] 

[nz,  oz,  az,  p ] 

[si2*nx-c12*ny,  Si2*ox-c12*oy,  Si2*ax-Ci2*ay,  s12*px-c12*py  ] 

[di*nz,  d!*oz,  di*az,  l+di*pz] 
t25  = 

[c345>  0,  s345,  a4*c34+a3*c3] 

[s345  , 0,  -c345,  a4*s34+a3*s3  ] 


(13) 

(14) 

(15) 

(16) 

(17) 

(18) 


Impact  Factor  (JCC):  1.5422 


Index  Copernicus  Value  (ICV):  3.0 
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[0,  l,0,d] 

[0,  0,  0,  1 ] 

From  the  element  (1,  4)  & (2, 4)  of  the  Equation  (19),  we  get 

Cl2*Px+Sl2*Py  = a4*C34+a3*C3 

Pz=  a4*S34+a3*S3 

Squaring  both  side  and  then  adding  the  squares  gives,  we  get 

(ci2*px+Si2*Py)2+(Pz)2  = (a4*c34+a3*C3)2+(a4*s34+a3*s3)2 
= (a3)2+(a4)2+2*a3*a4*c4 

Since,  s3*S34+c3*C34  = Cos  [(03+  04)  - 03]  = Cos  04 
C4  = {(ci2*Px+Si2*Py)2+(Pz)2  - (a3)2+(a4)2}/(2*a3*a4) 

Knowing  that,  s4  = , we  can  say  that, 

04  = tan"1  (s4/c4)  _ ^ 

Now  again  referring  to  the  Equation  (20),  we  can  calculate  03  as  follows. 
c3  = (ci2*px  + Si2*py  - a4*c34)/a3; 
s3  = (Pz  - a4*s34)/a3; 

03  = tan"1  (s3/c3) 

X4  = (°T ! )" 1 *(IT2)'1*(2T3)'1*(3T4)'1*  Te  = 4T5 
From  the  element  (1,  4)  of  the  Equation  (23),  we  get 

C34*Cl2*Px+C34*Sl2*Py+S34*Pz  = 0; 

034  = - tan  * { (Ci2*px+Si2*Py)/pz} 

05  = 0345  ‘ 034 

FORWARD  KINEMATIC  CASE-STUDY  & RESULT 


(19) 

(20) 


(21) 

(22) 


(23) 

(24) 


(25) 

(26) 


For  the  given  set  of  parameter,  a program  in  MATLAB  8.0  is  made.  Developed  model  is  used  to  determine 
position  and  orientation  of  end  effector.  For  the  values  of  01  = 30°,  02  =50°,  03  = 45°,  04  = 25°  and  05  = 0°,  results 
obtained  is  shown  below. 

The  DH  parameters  of  5 DOF  Robotic  Arm  is  as  follows: 
a alpha  1 d theta 

0.0000  0.0000  86.0000  50.0000 
0.0000  90.0000  0.0000  30.0000 
96.0000  0.0000  0.0000  45.0000 
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96.0000  0.0000  0.0000  25.0000 
0.0000  90.0000  59.5000  0.0000 

The  Final  Matrix  (°T5)  by  Matlab  Program  is  as  follows: 

0.0594  0.9848  0.1632  76.0852 
0.3368  -0.1736  0.9254  88.8540 
0.9397  0.0000  -0.3420  244.0927 
0.0000  0.0000  0.0000  1.0000 

The  final  end-effector  position  is  Px  = 76.0852,  Py  = 88.8540,  Pz  = 244.0927. 

For  the  given  set  of  parameter,  a program  in  MATLAB  8.0  is  made.  Developed  model  is  used  to  determine 
position  and  orientation  of  end  effector.  For  the  values  of  01  = 30°,  02  =50°,  03  = 45°,  04  = 25°  and  05  = 0°,  results 
obtained  is  shown  below. 

The  DH  parameters  of  5 DOF  Robotic  Arm  is  as  follows: 

a alpha  1 d theta 

0.0000  0.0000  86.0000  50.0000 

0.0000  90.0000  0.0000  30.0000 

96.0000  0.0000  0.0000  45.0000 

96.0000  0.0000  0.0000  25.0000 

0.0000  90.0000  59.5000  0.0000 

The  Final  Matrix  (0T5)  by  Matlab  Program  is  as  follows: 

0.0594  0.9848  0.1632  76.0852 
0.3368  -0.1736  0.9254  88.8540 
0.9397  0.0000  -0.3420  244.0927 
0.0000  0.0000  0.0000  1.0000 

The  final  end-effector  position  is  Px  = 76.0852,  Py  = 88.8540,  Pz  = 244.0927. 

CONCLUSIONS 

A complete  analytical  solution  to  the  forward  and  inverse  kinematics  of  5 DOF  Robotic  arm  is  derived  in  this 
paper.  The  forward  kinematic  analysis  of  5 DOF  robotic  arm  is  investigated.  The  mathematical  model  is  prepared  and 
solved  for  positioning  and  orienting  the  end  effectors  by  preparing  a programme  in  MATLAB  8.0.  The  result  of  the 
forward  kinematics  can  be  crossed  checked  by  the  analytical  method  of  inverse  kinematic  model.  Hence  this  proves  the 
utility  of  the  5 DOF  robotic  arm  as  an  educational  tool  for  undergraduate  robotics  courses. 


Impact  Factor  (JCC):  1.5422 
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